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Motion Planning for Unlabeled Discs with 
Optimality Guarantees 

Kiril Solovey*, Jingjin Yu ' . Or Zamir* and Dan Halperin* 


Abstract —We study the problem of path planning for unla¬ 
beled (indistinguishable) unit-disc robots in a planar environment 
cluttered with polygonal obstacles. We introduce an algorithm 
which minimizes the total path length, i.e., the sum of lengths 
of the individual paths. Our algorithm is guaranteed to find a 
solution if one exists, or report that none exists otherwise. It runs 
in time O (m 4 + m 2 n 2 ), where m is the number of robots and 
n is the total complexity of the workspace. Moreover, the total 
length of the returned solution is at most OPT + 4m, where OPT 
is the optimal solution cost. To the best of our knowledge this 
is the first algorithm for the problem that has such guarantees. 
The algorithm has been implemented in an exact manner and 
we present experimental results that attest to its efficiency. 


I. Introduction 

We study the problem of path planning for unlabeled 
(i.e., indistinguishable) unit-disc robots operating in a planar 
environment cluttered with polygonal obstacles. The problem 
consists of moving the robots from a set of start positions 
to another set of goal positions. Throughout the movement, 
each robot is required to avoid collisions with obstacles and 
well as with its fellow robots. Since the robots are unlabeled, 
we only demand that at the end of the motion each position 
will be occupied by exactly one robot, but do not insist on 
a specific assignment of robots to goals (in contrast to the 
standard labeled setting of the problem). 

Following the methodology of performing target assign¬ 
ments and path planning concurrently [DEED and adopting a 
graph-based vertex ordering argument from S), we develop 
a complete combinatorial algorithm to the unlabeled prob¬ 
lem described above. Our algorithm makes two simplifying 
assumptions regarding the input. First, it assumes that each 
start or goal position has a (Euclidean) distance of at least 
y/5 to any obstacle in the environment (recall that the robot 
discs have unit radius) . Additionally, it requires that the 
distance between each start or goal position to any other such 
position will be at least 4 (see Figure [T}. Given that the two 
separation conditions are fulfilled, out algorithm is guaranteed 
to generate a solution if one exists, or report that none exists 
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otherwise. It has a running tim^jof O (to 4 + m 2 n 2 ), where to 
is the number of robots, and n is the description complexity 
of the workspace environment, i.e., the number of edges of 
the polygons. Furthermore, the total length of the returned 
solution, i.e., the sum of lengths of the individual paths, is at 
most OPT + 4 to, where OPT is the optimal solution cost. 

This paper should be juxtaposed with another work by the 
authors El in which we show that a slightly different setting 
of the unlabeled problem is computationally intractable. In 
particular, we show that the unlabeled problem of unit-square 
robots translating amid polygonal obstacles is PSPACE-hard. 
Our proof relies on a construction of gadgets in which start 
and goal positions are very close to one another or to the 
obstacles, i.e., no separation is assumed. This can be viewed 
as a justification to the assumptions used in the current paper 
which allow an efficient solution of the problem. 

We make several novel contributions. To the best of our 
knowledge, we are the first to describe a complete algorithm 
that fully addresses the problem of planning minimum total- 
distance paths for unlabeled discs. We mention that Turpin 
et al. |3] describe a complete algorithm for unlabeled discs; 
however their algorithm minimizes the maximal path length of 
an individual robot. Furthermore, our algorithm makes more 
natural assumptions on the input problem than the ones made 
by Turpin et al. We also mention the work by Adler et al. a 
in which a complete algorithm is described, but it does not 
guarantee optimality. While the latter work makes the same 
assumption as we make on a separation of 4 between starts and 
goals, it does not assume separation from obstacles. However, 
it requires that the workspace environment will consist of a 
simple polygon. On the practical side, we provide an exact 
and efficient implementation which does not rely on non- 
deterministic procedures, unlike sampling-based algorithms. 
The implementation will be made publicly available upon the 
publication of this paper. 

Our work is motivated by theoretical curiosity as well as po¬ 
tential real world applications. From a theoretical standpoint, 
we have seen great renewed interests in developing planning 
algorithms for multi-robot systems in continuous domains (see, 
e.g., l3l l7l l8l l9l [Toll) and discrete settings (see, e.g., El ITT)). 
Whereas significant headway has been made in solving multi¬ 
robot motion-planning problems, many challenges persist; the 
problem studied in this paper—path planning for unlabeled 
disc robots in a general environment with guarantees on total 
distance optimality—remains unresolved (until now). On the 

1 For simplicity of presentation, we omit log factors when stating the 
complexity of the algorithm, and hence use the O notation. 
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Fig. 1: Illustration of the separation conditions assumed in this work. The green and purple discs represent two unit-disc robots 
placed in s £ S, t £ T, respectively. The blue line represents the unit radius of the robot (for scale). The distance between 
s and t, is at least 4 units (see dashed orange line). The gray rectangle represents an obstacle, and the point o represents the 
closest obstacle point to s. Notice that the distance between o and s is at least \Jh units (see dashed red line). 


application side, in the past few years, we have witnessed the 
rapid development and adaptation of autonomous multi-robot 
and multi-vehicle systems in a wide variety of application 
domains. The most prominent example is arguably the success 
of Kiva Systems, now part of Amazon, which developed a 
warehousing system employing hundreds of mobile robots to 
facilitate order assembly tasks ED. More recently, Amazon, 
DHL, and Google have demonstrated working prototypes of 
aerial vehicles capable of automated package delivery. Since 
the vehicles are intended to operate in an autonomous, swarm¬ 
like setting, we can foresee in the near future the emerging 
demand of efficient path planning algorithms designed for 
such systems. We note that when the warehouse robots or the 
delivery aerial vehicles do not carry loads, they are effectively 
unlabeled robots. In such scenarios, planning collision-free, 
total-distance near-optimal paths translates into allowing the 
vehicles, as a whole, to travel with minimum energy consump¬ 
tion. 

The rest of the paper is organized as follows. In Sec¬ 
tion [II] we review related work. In Section [HI] we provide an 
overview of our algorithm and necessary background material. 
In Section IV we establish several basic properties of the 
problem and describe the algorithm in Section [V] We report 
on experimental results in Section VI and conclude with a 
discussion in Section [VTi] 


II. Related work 

The problem of multi-robot motion planning is notoriously 
challenging as it often involves many degrees of freedom, and 
consequently a vast search space lfl3l [14 1. In general, each 
additional robot introduces several more degrees of freedom 
to the problem. Nevertheless, there is a rich body of work 
dedicated to this problem. The earliest research efforts can be 
traced back to the 1980s fT31 . 

Approaches for solving the problem can be typically subdi¬ 
vided into categories. Decoupled techniques (see, e.g., M 
El M HU EQl EQ) reduce the size of the search space 
by partitioning the problem into several subproblems, which 
are solved separately, and then the different components are 
combined. In contrast to that, centralized approaches (see. 


e.g., E2l l23l i24l . 25l l26l 27] [28)) usually work in the 
combined high-dimensional configuration space, and thus tend 
to be slower than decoupled techniques. However, centralized 
algorithms often come with stronger theoretical guarantees, 
such as completeness. Besides these, the multi-robot motion¬ 
planning problem has also been attacked using methods based 
on network flow J8) and mixed integer programming [[29j, 
among others. 

Multi-robot motion planning can also be considered as a 
discrete problem on a graph lf30i . In this case the robots are 
pebbles placed on the vertices of the graph and are bound 
to move from one set of vertices to another along edges. 
Many aspects of the discrete case are well understood. In 
particular, for the labeled setting of the problem there exist 
efficient feasibility-test algorithms EH EH [33], as well as 
complete planners (J9j [34] [35]). For the unlabeled case, there 
even exist complete and efficient planners that generate the 
optimal solution 0 no 12a under different metrics. While 
there exists a fundamental difference between the discrete and 
the continuous setting of the multi-robot problem, the con¬ 
tinuous case being exceedingly more difficult, several recent 
techniques in the continuous domain EHDE3 have employed 
concepts that were initially introduced in the discrete domain. 

As mentioned above, the works by Adler et al. 16) and 
Turpin et al. E) solve very similar settings of the unlabeled 
problem for disc robots to the one treated in this paper, only 
with different assumptions and goal functions, and thus it is 
important to elaborate on these two techniques. Adler et al. ia 
show that the unlabeled problem in the continuous domain 
can be transformed into a discrete pebble-motion on graph 
problem. Their construction guarantees that in case a solution 
to the former exists, it can be generated by solving a discrete 
pebble problem and adapted to the continuous domain. In 
particular, a motion of a pebble along an edge is transformed 
into a motion of a robot along a local path in the free space. 
Turpin et al. E) find an assignment between starts and goals 
which minimize the longest path length traveled by any of 
the robots. Given such an assignment a shortest path between 
every start position to its assigned goal is generated. However, 
such paths still may result in collisions between the robots. 
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The authors show that collisions can be elegantly avoided by 
prioritizing the paths. Our current work follows to some extent 
a similar approach, although in our case some of the robots 
must slightly stray from the precomputed paths in order to 
guarantee completeness—a thing which makes our technique 
much more involved. This follows from the fact that we make 
milder assumptions on the input. Another difference is that the 
goal function of our algorithm is to minimize the total path 
length, which requires very different machinery than the one 
used by Turpin et al. 

III. Preliminaries and algorithm overview 

Our problem consists of moving to indistinguishable unit- 
disc robots in a workspace Wd 2 cluttered with polygonal 
obstacles, whose overall number of edges is n. We define O := 
R 2 \ W to be the complement of the workspace, and we call 
O the obstacle space. For given r £ R + ,x £ R 2 , we define 
B r (x) to be the open disc of radius r, centered at x. For given 
r £ M + , A' C R 2 we also define B r (X) := Uzev B r (x). 

We consider the unit-disc robots to be open sets. Thus a 
robot avoids collision with the obstacle space if and only if 
its center is at distance at least 1 from O. More formally, the 
collection of all collision free configurations, termed the free 
space, can be expressed as T := {a; £ R 2 : B\(x) (T O = 0}. 
We also require the robots to avoid collisions with each other. 
Thus for every given two configurations x, x' £ T two distinct 
robots can be placed in x and x' only if ||x — x'\\~^ 2. 
Throughout this paper the notation ||-|| will indicate the L 2 
norm. 

In addition to the workspace W we are given sets S = 
{si, S 2 , s m } and T = {t\, t 2 ,t m } such that S,T CT. 
These are respectively the sets of start and goal configurations 
of our to indistinguishable disc robots. The problem is now 
to plan a collision-free motion for to unit-disc robots such 
that each of them starts at a configuration in S and ends at a 
configuration in T. Since the robots are indistinguishable or 
unlabeled, it does not matter which robot ends up at which 
goal configuration, as longs as all the goal configurations are 
occupied at the end of the motion. Formally, we wish to find 
to paths 7 Tj : [0, 1 ] —»• T, for 1 ^ i ^ to, such that 77(0) = Si 
and Q™ 1 77(1) = T. Furthermore, we are interested in finding 
a set of such paths which minimizes the expression Y^iLi W' 
where 77 represents the length of 77 in the L 2 norm. 

A. Simplifying assumptions 

By making the following simplifying assumptions (see Fig¬ 
ure 0 we are able to show that our algorithm is complete and 
near-optimal. The first assumption that we make is identical 
to the one used by Adler et al. Q. It requires that every pair 
of start or goal positions will be separated by a distance of at 
least 4: 

W, v' £ S U T, \\v-v'\\^ 4. (1) 

The motivation for the above assumption is the ability to prove 
the existence of a standalone goal —a goal position that does 
not block other paths, assuming that the paths minimize the 
total length of the solution. 


We also need the following assumption in order to guarantee 
that the robots will be able switch targets, in case that a given 
assignment of robots to goals induces collision between the 
robots: 

fv £ S U T and Vx £ O , ||t; — x\\^ y/5. (2) 

B. Overview of algorithm 

Here we provide an overview of our technique. Recall that 
our problem consists of S, T, which specify the set of start 
and goal positions for a collection of to unit-disc robots, and 
a workspace environment W. 

We describe the first iteration of our recursive algorithm. For 
every s, £ S, tj £ T we find the shortest path 7 I : [0,1] —»• T 
from s, to tj. Among these to 2 paths we select a set of m 
paths F = { 71 ,..., 7 m }, where 7 * : [ 0 , 1 ] -A T for every 
1 < i < to, such that U™i{7i(0)} = S, Uili{ 7 i( 1 )} = 
T. Furthermore, we require that T will be the path set that 
minimizes the total length of its paths under these conditions. 
Note that at this point we only require that the robots will 
not collide with obstacles, and do not worry about collisions 
between the robots. The generation of T is described in detail 
in Section [V] Theorem [13] 

In the next step we find a goal t £ T which does not block 
paths in F that do not lead to t. We call such at a standalone 
goal. Next, we find a start s £ S from which a robot will be 
able to move to t without colliding with other robots situated 
in the rest of the start positions. We carefully select such a start 
s and generate the respective path to t in order to minimize 
the cost of the returned solution. We prepare the input to the 
next iteration of the algorithm by assigning S := 5\{s}, T := 
T \ {t\. and by treating the robot placed in t as an obstacle, 
i.e., W:=W\Bi(i). 

IV. Theoretical foundations 

In this section we establish several basic properties of 
the problem. Recall that our problem is defined for a 
workspace W, whose free space for a single unit-disc robot is 
T. Additionally, we have two sets of start and goal positions 
S = {s lt ...,s m },T = {t 1 ,...,t m }, respectively. 

The following lemma implies that if a robot moving from 
some start position s £ S along a given path collides with 
a region B\{t), for some other goal t £ T, then there exists 
another path 7 £ T which moves the robot from s to t. In 
the context of our algorithm this lemma implies that if a path 
for a robot interferes with some other goal position, then the 
path can be modified such that it will move the robot to the 
interfering goal instead. 

Lemma 1. Let v £ SL)T and x £ T such that Bi(x)C\Bi(v) 

0. Then the straight-line path from x to v is contained in J-, 
i.e., xv C T. 

Proof: Here we use the fact that for every o £ O it holds 
that ||i; — o||^ y/5, which is the second separation assump¬ 
tion. Without loss of generality, assume that the straight-line 
segment from v to x is parallel to the x-axis. Denote by A 
and B the bottom points of the unit discs around v and x, 
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respectively (see Figure [2]). Similarly, denote by C and D the 
top points of these discs. By definition of v, x, we know that 
||i> — a:||< 2. Thus, ||i; — B || = ||i; — D\\< \/E (see dashed red 
segment). This implies that the rectangle defined by the points 
A, B, C , D is entirely contained in W (see orange square). 
Thus, the straight-line path xv is fully contained in F. ■ 

Definition 2. Let T be a set of in paths {71 ,..., 7 m } such that 
for every 1 ^ i ^ m, 7 , : [0,1] ->• F, S = U™i{7i(0)}; T = 
|J™ 1 { 7 i (l)}. We call T the optimal-assignment path set for 
S, T, F, if it minimizes the expression |T|:= X^t=il7*l> overall 
such path sets. 

Note that T is not necessarily a feasible solution to our 
problem since at this stage we still ignore possible colli¬ 
sions between robots. Let T = { 71 ,... , 7 m } be an optimal- 
assignment path set for S,T,F. Without loss of generality, 
assume that for every 1 ^ ^ to, 7 i( 0 ) = , 7 , 7 ^( 1 ) = 

Definition 3. Given an optimal-assignment path setT, we call 
tk £ T a standalone goal, for some 1 7 k f to, if for every 
7i € r, i 7^ k it holds thatB\(tk) 17*81(7*) = 0 . 

Standalone goals play a crucial role in our algorithm. We 
first show that at least one such goal always exists. 

Theorem 4. Let T be an optimal-assignment path set. Then 
there exists a standalone goal. 


7 f the subpath of 7 * that starts with .7 and ends with x. Define 
7 ' to be the concatenation of yf and xti+\. 

We need to show first that 7 ' C F and that \y[\< | 7 *|. The 
subpath 7 ? is obstacle-collision free, and so is xt t+ \ according 
to Lemma [I] Thus, 7 ' is free as well. Now, note that |x 
fj+i||< 2 and j|f i+1 — L||^ 4. Thus, by the triangle inequality 
||x — L||^ 2. This finishes our proof. ■ 

We introduce the notion of 0 -hop and 1 -hop paths. Infor¬ 
mally, a 0 -hop path is a path assigned to the standalone goal 
which is not blocked by any start position. 

Definition 5. Let tk be a standalone goal. The path 7 k is called 
a 0 -hop path if for every Si £ S,i 7 ^ k it follows that B\ ( 7 ) (T 

Bt( 7 fc)= 0 - 

Definition 6 . Let tk be a standalone goal, and suppose that 
7 k is not 0 -hop. Let x £ 7 k be the farthest point along 7 k for 
which there exists Si £ S such that B\ (7) IT Bi{x) 7^ 0 . The 
1-hop path, which is denoted by H- : , is a concatenation of the 
straight-line path 74 : and a subpath of 7 % that starts at x and 
ends in tk ■ 

Namelly, the 1-hop path moves the robot situated in . 7 , 
which interferes with 7 k, to tk (see Figure [3]). The following 
theorem shows that a robot situated in .7 that blocks the 0 - 
hop path can be moved to tk without inducing collisions with 
other robots. 


Proof: Assume by contradiction that every goal t, inter¬ 
feres with some path 7 j £ F, i f j. This implies that there 
is a circular interference, i.e., there exist t f m goals, which 
we denote, for simplicity and without loss of generality, as 
ti,...,tt such that for every 1 < i < i, B\{ti)C\Bi{yi-i) 7 ^ 0, 
and B\{ti) 17 Bi{yf) 7 ^ 0. More formally, let T be a directed 
graph vertices are T. For every £, which interferes with a path 
7 j, where j / 1 we draw an edge from t, to t ;) . If there exists 
no standalone goal then T has a directed cycle of size greater 
than one. This is due to the fact that if T were directed acyclic 
then it should have had a node whose out degree is zero. 

We show that in this case, the paths 71 ,..., 7 1 do not 
induce the minimal assignment for the starts and goals 
{si,..., s^}, {ti,.. ., L}. This would imply that T is not the 
optimal assignment path set. We claim that instead of assigning 
Si to ti we may assign ,7 to ti+i for 1 ^ i < £ and from 
Se to t\ and get a collection of paths 7 ^,..., 7 ^, such that 
l7il< 17i| f°r every 1 ^ i ^ £. Denote by x £ 7 * the first 
interference point with £,; +] along 77 Additionally, denote by 



Theorem 7. Let tk be a standalone goal. Suppose that 7 k is not 
0 -hop and let II-' be the 1-hop path from Si to tk- Then it holds 
that for every Sj £ S,j 7 ^ i,k, B\{H f) nBi(sj) = 0. 

Proof: By separation of start positions, and by definition 
of x (see Definition[ 6 ]), there exists a single start position ,7 for 
which B\(x) n£>i(s,) f 0. By Lemma [I] and the separation 
condition, the path ~sfx, does not induce collisions between 
a robot moving along it and other robots placed in Sj, for 
1 ^ j ^ to, j f i,k. Finally, by definition of x, the rest of 
the path Hf, which is a subpath of 7 k, is free of collisions 
with a robot situated in Sj. ■ 

After moving a robot from s,; to tk we have to ensure that 
some other robot can reach t, . We define the following switch 
path (see Figure [3]!. 



Fig. 3: Example of 1-hop and switch paths, tk is a standalone 
goal. The 1-hop path Hf is drawn as a dashed red curve, while 
the switch path H l k is drawn as a dashed blue curve. 
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Definition 8. Let tk be a standalone goal and suppose that 
jk is not 0-hop. The switch path Hf is a concatenation of the 
following paths: (1) the subpath of y k that starts in s k and ends 
in x; (2) xsf.; (3) 7 

Lemma 9. Let Iff be a switch path. Then Bi{Hf)C\Bi(t k ) = 

0 . 

Proof: Iff can potentially interfere with tk only along 
xly, due to the definition of x. For any y £ xs, it follows that 
||2/ — Si||< 2. If \\y — tk\\< 2 then it follows that ||sj — ffe||< 4, 
which is a contradiction. ■ 

Corollary 10. Let Hf. Hf be the 1-hop and switch paths, 
respectively. Then \Hf\ + \Hf\ = |7i| + | 7 fc|+ 4 . 

V. Near-optimal algorithm for unlabeled 

PLANNING 

In this section we describe our algorithm for the unlabeled 
multi-robot motion planning problem of unit-disc robots mov¬ 
ing amid polygonal obstacle and establish its completeness. 
Additionally, we bound the cost of the returned solution. 
Finally, we analyze the complexity of the algorithm. 

A. The algorithm 

We describe our recursive algorithm, which returns a set 
of m paths II. Recall that the input consists of S,T and a 
workspace VV, which induces the free space IF. The algorithm 
first produces the optimal-assignment path set F. Let OPT be 
the optimal solution cost and note that |r|^ OPT since |T| is 
a lower bound on the actual cost, as interactions between the 
robots might increase the traversed distance. 

Let tk be a standalone goal, which exists according to 
Theorem [4] Suppose that the 0-hop path 77,. is not blocked 
by any other robot located in a start position. Then, y k is 
added to II and the algorithm is run recursively on the input 
S' := S \ {s/ c },T / ■= T \ {tk}, with the workspace W' := 
W\Bi(tk), which results in the free space IF' := IF\B 2 (tk), 

Alternatively, in case that 77, is blocked, i.e., in interference 
with some Si £ S,i k, the algorithm produces the 1- 
hop path Hf, as described in Theorem [ 7 ] and adds it to II. 
Then, the algorithm is run recursively on the input S' := 
S\{si},T 1 := T\{tk}, with the workspace W' :=W\Bi{t k ), 
and the free space IF' := F \ B'^itk). 

B. Completeness and near-optimality 

We first show that the algorithm is guaranteed to find a 
solution, if one exists, or report that none exists otherwise. 

Theorem 11. Given an input S, T , W, which complies with 
assumptions [7] J2| (Section |7//-.A| ). and for which the number of 
start and goal positions for every connected component of F is 
the same, the algorithm is guaranteed to find a solution for the 
unlabeled multi-robot motion-planning problem. 

Proof: Consider the first iteration of the algorithm. Let 
r := { 71 ,... , 7 m} be the optimal-assignment path set and let 
tk be a standalone goal. 


Suppose that y k is a 0-hop path. Then, for every j f k, 
7 jCJ \ £> 2 (ffc), since tk is a standalone goal. Now suppose 
that 7 fc is not a 0-hop path. By Theorem [ 7 ] the 1-hop path Ilf 
from Si to tx does not collide with any other start position. 
By Lemma p\Hf C IF \ B-Atk ). Additionally, notice that for 
every j i, k, 7 jCJ \ B 2 (t k ). 

Thus, in any of the two situations, the removal of the 
standalone goal does not separate between start and goal 
configurations that are in the same connected component of 
F. Note that in the first level of the recursion the existence 
of a standalone goal t k guarantees the existence of a path 
to t k which does not collide with the other robots. This is 
possible due to assumptions |T| [2] Thus, in order to ensure the 
success of the following recursions, we need to show that these 
assumptions are not violated. First, note that assumption [T] is 
always maintained, since we do not move existing start and 
goal positions. Secondly, when a robot situated in t k is treated 
as an obstacle added to the set O := O0Bi(t k ) (or conversely 
removed from T, as described above), the first assumption 
induces the second. ■ 

We proceed to prove the near-optimality of our solution. 

Theorem 12. Let II be the solution returned by our algorithm 
and let I be the optimal-assignment path set for S , T, VV. Then 
|n| <C OPT + Am, where OPT is the optimal solution cost. 

Proof: Let T := { 77 ,..., 7 m } be the optimal-assignment 
path set for the input S, 7'. W, and let t k be a standalone. 
Additionally, assume that the algorithm generated the 1-hop 
path Hf, since 77 was blocked (the case when y k is not 
blocked is simpler to analyze). Let Hf be the switch path 
from s k to ti. Similarly, denote by L' the optimal-assignment 
path set for S' := S\{si},T' := T\{t k } and the workspace 
W := VV \ Bi(t k ), which induces the free space J 7 '. 

We will show that | F' | -F17?/° | ^ OPT + 4. As mentioned in 
Theorem [TT| for every j f i, k, it follows that for 7 j £ T 
and 7 j C IF'. We also showed that the same holds for Hf, 
i.e., Hf C IF'. Thus, the path set R := (T \ {7 i; y k }) U {Hf} 
represents a valid assignment for S',T',IF', even though it 
might not be optimal. This means that |r'|^ /?|. Thus, 


\T'\+\Hf\ ^ \R\+\Hf\= J2 hj\+\Hf\+\Hf\ 

m 

<5Il7fc|+4=|r|+4<OPT + 4, 

fc=1 


where the third step is due to Corollary 10 Thus, every 


level of the recursion introduces and additive error factor 
of 4. Repeating this process for the m iterations we obtain 
|II|< OPT + 4m. ■ 


C. Complexity Analysis 

We analyze the complexity of the algorithm. In order to 
do so, we have to carefully consider the operations that are 
performed in every iteration of the algorithm. 

Theorem 13. Given m unlabeled unit-disc robots operating in 
a polygonal workspace with n vertices, the algorithm described 
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above returns a solution, or reports that none exists otherwise, 
with a running time of O (to 4 + m 2 n 2 ). 

Proof: Let us consider a specific iteration j. The input 
of this iteration consists of to — j + 1 start positions Sj and 
to — j + 1 goal positions Tj. The workspace region of this 
iteration is defined to be VV ? - := W \ (£>i (T \ Tj)), which 
induces the free space Jg. Note that ,S'i = ,5'. 1\ = T. T\ = 
^Ti = T. 

In order to find the optimal-assignment path set Tj for 
Sj, Tj , Tj one has to first find the shortest path in Tj for every 
pair of start and goal positions s £ Sj,t £ Tj. Given the costs 
of all those combinations, the Hungarian algorithm 13810 finds 
the optimal assignment, and so Tj is produced. In the next step, 
a standalone goal t*. is identified and it is checked whether the 
0 -hop path leading to tk is clear, in which case 7 *. is added 
to n. If it is not, one needs to find the last start position that 
interferes with this path and generate the respective 1 -hop path, 
which will be included in n. 

The complexity of finding a shortest path for a disc depends 
on the complexity of the workspace, which in our case is 
()(ri + j). This task is equivalent to finding a shortest path 
for a point robot in Tj. The generation of T t can be done 
in O ((n + j) log 2 (n + j)) time complexity, and the overall 
complexity of this structure would be 0(m + j) |[39l . A 
common approach for finding shortest paths in the plane is 
to construct a visibility graph l40l which encapsulates infor¬ 
mation between every pair of vertices of a given arrangement 
of segments, while avoiding crossings with the segments. 
In our case, the arrangement should include T t as well as 
all the points from Sj and Tj. Thus, we would need to 
generate a visibility graph over a generalized polygon of total 
complexity 0(m + n). This can be done in O ((to + n) 2 ) = 
0(to 2 + n 2 ) ll40[j Given the visibility graph with 0(m + n) 
vertices and 0(rrr + n 2 ) edges we find for each s £ Sj 
the shortest path to every t £ Tj. For each s we run the 
Dijkstra algorithm which requires 0(m 2 +n 2 ) time, and finds 
the shortest path from the given s to any t £ Tj. Since 
Sj | = m — j + 1, the total running time of finding the shortest 
path from every start to every goal is 0((m — j)(m 2 +n 2 )). 

To find Tj we employ the Hungarian algorithm f38l . which 
runs in O ((to — j) 3 ) time. Now, given T ; we wish to find a 
standalone goal tk- We first note that the complexity of each 
path in l’ ; is bounded by the complexity of Tj, which is 
0(n+j). For every t t £ Tj, 7 */ £ Tj,i 7 ^ i' we check whether 
n£?i( 7 j') 7 ^ 0. This step has a running time of 0 ((to — 
j)(m — j)(n + j)) = 0((m — j) 2 {n + j)). Finding the last 
closest blocking start from S 7 of the path 7 /. takes additional 
0 ((to — j)(n + j)) time by going over all starts in Sj and 
comparing the distance of their interference point with 7 *.. 


-Also known as the Kuhn-Munkres algorithm. 

3 We note that in our setting the arrangement consists not only of straight- 
line segments, but also of circular arcs which are induced by robots situated 
in target positions. Yet, the algorithm constructing the visibility graph can 
treat such cases as well, while still guaranteeing the (near-)quadratic run-time 
complexity mentioned above. 


Thus, the overall complexity of a given iteration j is 

O ((m—j)(m 2 +n 2 ) + (m—j) 3 + (m— j) 2 (n+ j) + (m—j) 2 ) 

= O ((to — j){m 2 + n 2 )) . 

Note that the cost of the different components is absorbed in 
the cost of calculating the shortest paths. We conclude with 
the running time of the entire algorithm: 

O (yf rn — j)(m 2 + n 2 )^ = O (to 4 + m 2 n 2 ) . 

■ 

VI. Experimental results 

We implemented the algorithm and evaluated its perfor¬ 
mance on various challenging scenarios. 

A. Implementation details 

First, we wish to emphasize that our implementation deals 
with geometric primitives, e.g., polygons and discs, and does 
not rely on any graph discretization of the problem. The 
implementation relies on exact geometric methods that are 
provided by CGAL ED. As such, it is complete, robust 
and deterministic. In addition to that, the implementation is 
parameter-free. 

We implemented the algorithm in C++ and relied heavily 
on CGAL for geometric computing, and in particular on the 
Arrangement_2 package |42| . Generation of the free space 
was done using Minkowski sums, while shortest paths were 
generated using visibility graphs H40| . In order to find the 
optimal assignment, we used a C++ implementation of the 
Hungarian algorithm 113811 . available at m. 

B. Test scenarios 

We report in Table [I] on the running time of the algorithm 
for the four scenarios depicted in Figure [4] The grid scenario 
(Figure [4a| is used to illustrate the performance of the al¬ 
gorithm in a sterile obstacles-free workspace. The triangles 
and cross scenarios (Figure |4b|4d| > include multiple obstacles, 
which have a tremendous affect on the performance of the 
algorithm. The maze scenario (Figure |4c]i, which also includes 
multiple obstacles, has several narrow passages. 

It is evident that the running time is dominated by shortest- 
path calculations (see Theorem The second largest con¬ 
tributor to the running time of the algorithm, is the calculation 
and maintenance of the configuration space, which includes 
the update of the free space for every iteration. A interesting 
relation is found between the overall complexity of finding 
the optimal assignment (0(m 4 )) and its modest contribution 
to the actual running time in practice, when compared to 
the other components. This can be explained by the fact that 
the implementation of the Hungarian algorithm ll43]| employs 
floating-point arithmetic, while the geometric operations, e.g., 
shortest pathfinding, rely on exact geometric kernels, which 
have unlimited precision ED- It is noteworthy that the al¬ 
gorithm produces solutions whose cost is very close to the 
optimal cost. 
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(d) cross 


Fig. 4: Test scenarios. Obstacles are represented as gray polygons. Discs represent robots placed in start (red) and goal (blue) 
positions, (a) Grid scenario with 40 robots, (b) Triangles scenario with 32 robots and multiple triangular obstacles, (c) Maze 
scenario with with 26 robots; robots need to pass through a collection of narrow passages in order to reach their goals, (d) 
Cross scenario with 8 robots and several wall obstacles. 


To gather a better understanding of the running time of the 
algorithm, we also report on the running time of each iteration 
for the triangles scenario (see Figure [5a]). For every iteration 
1 ^ j ^ 32 we report on the running time of maintaining the 
configuration space, and finding shortest paths. 

Another important aspect of the algorithm is the relation 
between the number of robots and the performance. To test 
this relation we performed the following experiment, which is 
based on the triangles scenario as well. We report in Figure [5b| 
how the performance is affected by an increase or decrease in 
the number of robots. In order to maintain a similar level of 
density between the various tests we increase the radius of 
the robots to the maximal allowed radius which abides by the 
separation assumptions. 

The algorithm and its current implementation can deal with 
rather complex scenarios. However, it is clear that there is 
a limit to the number of robots or workspace complexity 
with which it can cope, due the relatively high degree of the 
polynomial, in the running time complexity. 

VII. Discussion and future work 
A. Relaxing the separation conditions 

The algorithm presented in this paper requires that two 
conditions will hold. First it is assumed that every pair of 
start or goal position will be separated by a distance of at 
least 4. The second condition requires that every start or goal 
positions will be separated from an obstacle by a distance of 
at least ~ 2.236. We b elieve that the obstacles-separation 
factor can be lowered to \/l3 — 6\/3 « 1.614 using a tighter 
mathematical analysis. While the proof for Lemma [l] would 
change, the rest of the proofs will not require any special 
modification. In the near future we aim to consider less strict 
separation requirements such as reducing the robots separation 
to 3 and removing the requirement that start positions will 
be separated from goal positions. However, it seems that the 
machinery described here will not suffice for the tighter setting 
and different tools will be required. 

We note that without adequate obstacle clearance, it is in 
fact impossible for any algorithm to guarantee a maximum 
0(m) deviation from the cost of an optimal-assignment path 


set, regardless of the separation between start and goals. 
For instance, see the gadget in Figure [6] The two pairs of 
(blue) start and (red) goal positions satisfy the 4 separation 
requirement. The disc starting at the bottom left, which we 
call disc 1, is matched by the optimal assignment with the 
goal on the top left of the figure, and the disc starting in the 
middle, which we call disc 2, is matched with the goal on the 
right. This is due to the fact that disc 1 and disc 2 reside in 
two disjoint components of the free space. For disc 1 to go 
through the lower tunnel, disc 2 must move non-trivially ( e.g., 
to the location of the green discs). Let this nontrivial distance 
be S. Then, as disc 1 passes through the upper tunnel, another 
nontrivial move of distance 6 must be performed by disc 2 to 
clear the way. Now, we remove disc 1 from the gadget and 
stack m/2 of the resulting gadget vertically. If we require the 
rest m/2 discs to pass through the stacked construction, a total 
distance penalty of £l(m 2 6) is incurred. 


Fig. 6: Illustration of a scenario in which every solution has a 
deviation of S2(m 2 ) from the cost of the optimal-assignment 
path set. 


B. Improving the algorithm 

It is evident from our experiments that most of the running 
time of the algorithm in practice is devoted to finding shortest 
paths. To be specific, in each iteration the algorithm performs 
a shortest-path search between every pair of start and target 
positions. This entire process is performed only for the sake 
of finding a single standalone goal. It will be interesting to 
investigate whether more information can be extracted from 
the optimal assignment returned by the Hungarian algorithm. 






















































Runnning time per iteration Runnning time for given number of robots 




Iteration no. Number of robots 

(a) (b) 

Fig. 5: Graphs depicting the running time of maintaining the configuration space, and finding shortest path, for the triangles 
scenario (Figure |4bj >. (a) Running time is reported separately for every iteration of the algorithm, (b) The behavior of the 
algorithm for a growing number of robots in the triangles scenario is depicted. 



Scenarios 

Grid 

Triangles 

Maze 

Cross 

scenario properties 

robots 

40 

32 

26 

8 

workspace vertices 

4 

118 

56 

44 

robot radius 

0.05 

0.034 

0.035 

0.09 

running time (sec.) 

configuration space 

261 

832 

141 

17 

shortest paths 

50 

5532 

658 

1 

optimal assignment 

0.016 

0.001 

0.016 

0 

standalone goal 

0.001 

0.016 

0.119 

0 

total 

311 

6394 

800 

19 

cost 

lower bound 

36.33 

10.41 

154.86 

12.11 

actual cost 

37.16 

10.69 

155.21 

12.4 

algorithm’s behavior 

0-hop paths 

25 

32 

14 

7 

1-hop paths 

1 

0 

12 

1 


TABLE I: Results of our algorithm for the scenarios depicted in Figure [f] We first describe the properties of each scenario, 
which consist of the number of robots, the complexity of the workspace (n), and the robot’s radius (every scenario is bounded 
by the [—1,1] 2 square). Then, we report the running time (in seconds) of the different components of the algorithm: construction 
and maintenance of the configuration space; calculation of shortest paths; calculation of the optimal assignment; search for 
a standalone goal. Then, we report the lower-bound cost of the solution and the cost of the actual solution returned by the 
algorithm. Finally, we report the number of iterations for which the algorithm returned a 0-hop or a 1-hop path. 


For instance, could there be two or more standalone goals to 
which there are separate non-interfering paths? 


C. Implementation in 3D 

For simplicity of presentation, our algorithm is discussed for 
the planar setting. Yet, its completeness and near-optimality 
guarantees hold also for the three-dimensional case with ball 
robots under the two separation assumptions used in this 
paper. A main requirement for a correct implementation of 
the algorithm is the ability to produce shortest paths for a 
single robot moving amid static obstacles. While this task 
does not pose particular challenges in the planar case, it 
becomes extremely demanding in 3D. In particular, finding a 
shortest path for a polyhedral robot translating amid polyhedral 
obstacles is known to be NP-Hard |45l . It would be interesting 
to investigate whether our algorithm can be extended to work 
with approximate shortest paths. 
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